#include <Servo.h>
#include "MH_TCS34725.h" //调用颜色识别传感器库函数

#include <Wire.h>        //调用IIC库函数
#include "MH_TCS34725.h" //调用颜色识别传感器库函数
#ifdef __AVR__
  #include <avr/power.h>//调用avr库函数用来设置CPU的工作频率
#endif
#include <Wire.h>//调用IIC库函数

// 定义舵机对象
Servo myServo;

// 定义舵机控制引脚
const int servoPin = 4;

// 定义颜色识别模块引脚
const int colorPin1 = A4;
const int colorPin2 = A5;
//颜色传感器不同通道值设置
MH_TCS34725 tcs = MH_TCS34725(TCS34725_INTEGRATIONTIME_50MS, TCS34725_GAIN_4X); //设置颜色传感器采样周期50毫秒
enum{Forward=1,Back,Left,Right,Stop};//定义小车状态：前进、后退、左转、右转、停止，分别对应1、2、3、4、5

void setup() {
  // 初始化串口通信
  Serial.begin(9600);

  // 将舵机连接到指定引脚
  myServo.attach(servoPin);

  //检测是否有颜色传感器模块
  if (tcs.begin()) {                 //如果检测到颜色传感器模块
    Serial.println("Found sensor");  //串口打印 Found sensor
  } else {                           //如果没有检测到颜色传感器模块
    Serial.println("No TCS34725 found ... check your connections");//串口打印：没有找到颜色识别传感器模块
    while (1); // halt! //程序陷入死循环
  }
 Motor_pin_init();//直流电机引脚初始化
 delay(500);
}

void loop() {
  Get_Color_Data();
}
